#include "openManipulatorTrajectoryPlanning.h"
P rtP ;
